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(57) Abstract: 

PROBLEM TO BE SOLVED: To calculate the distance 
between two convex objects at a high speed by providing 
a first closest approach vector computing means for 
obtaining a closest approach vector and a second closest 
approach vector computing means for correcting the 
closest approach vector. 

SOLUTION: A closest approach vector obtained in the 
first closest approach vector computing means 15 is the 
closest approach vector when both objects are regarded 
to be convex polyhedrons and is the closest approach 
vector of insufficient precision for a convex curved 
surface object. The closest approach vector obtained in 
such a manner is inputted to the second closest approach 
vector computing means 16 along with the shape 
information (including curved surface batch information) 
of the two convex objects to be the object. In the 
second closest approach vector computing means 16 r 
based on the principle that a plane in contact with a 
convex curved surface object and the closest approach 
vector for connecting the closest approach points of the 
two convex objects with each other are orthogonal at the 
closest approach point of the convex curved surface 



object, the obtained closest approach vector is 
corrected to the new closest approach vector of high 
precision further. 
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(54) i»99(7>«m toftmmmz&m&£zm*mmmm&7u?5&mm& 



(57) [»KJ] (HUE*) 
[sftBl a>fcr»-f±CC«|R3nfc«i* <CG (n> 

■traucwH-r*. 

Jg^* h^*««>&« lOAfiS*** hJl4M*?ft&. 

oftffi«f(to*ifi»^r£iftH»(ttc«r soffit 2 o 
Msr, ^loafi^^h^sist^sr^fefcaifiS 




£ ft T 36c * 2 o<D 3 %7cO«M*OKSflUIII 
SEUt*. »2o©Ci!»ftcr>, gBg{^<t$R£^tf?fcf#tlt 

fl*™#T*4»*<ottfliami#**j«T*i5fta 

SSMKjEi'IMilfc u < ttiW»jS«:^L»r<Drt»3W % ft 

«i>h)vz* mz&&w®t*<D&im&^m&&m®& 20 
[ M#gr 2 3 mmm 2 ©aaa*^ * h juaw^sr * 

3 ] Mis 2 o<d^»cd 3 -feo-^e^a 
± i*wair*»3WB 1 msHDWtmm 40 



1 0-742 1 5 
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^©^{fx/tc &*w*^^«ii3)n3iefi®iMmE 

(D^>^, is— ^(dq^^cd. »»*©ia»(*«:»-raft 

mum 1 hJH^r^eti/cMg 
^mzoMism^z bfrmn&mtzmztcctznm 

[»*» 7 3 ffrffim 2 ^ h ;«»fir* 

m-c h * m&tc tew zwh&n mom^om^^-r 
m«»*r & c i «c ct 0 mictmftftn*m>*>wM 

OT2i3»*3W*» i 0 < «^ ^ titcm^C x m B^ 1 



3 

mtma&m. - 

in*m 1 1 1 -#a^*ffif*r**c tifiimsti 
mm#v mmz tix a a 2 o© 3 ^M^otms 

[m*E 1 2 1 mfsmtmrnrnw?* v^^tfi. m 

l 3 ] ttBWtllHIWm^a ^7A*i, « 

&f»wc*^irKia«*(D3i*A Lima® 

ttirr&t©r**c4*w«i:-r*it«3!ii nets 
©ttttmeiHfi*:/;! AEtunt. 
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* 1 <Dsas^ * h iumc«Rcc«»ir^r*n« u < ax 

h^**»*C <tCtft*>r) , 1*12132 

■HHratas nr & s 2 o© 2 ^7cO«5ft<D®m«S 
or, 

«^©H*©ttg^ ^ h A . ^> U < tt«-*©0«!(*^ 
©9^, K-*©i£b®f*©, i^ffe^©i£b^^tcM-r^^ 

30 S*2©«J^^^ hii«B^S^*«T ^«J»lfflffi« 

1 6 ] «riE«ftni£fKii*^a ^^a*, m 
40 122 o©o«»©9 ft©-^r*«i5^»r*s»^K:*j 

uasraomcmt- * c <t k cfc 0 « 

&«#r«fc©r««c&«Hi&r«iMqii sen 
50 ©«iftfflffi«si»7 r py7Aga««8» 8 



5 

[ n#m i 8 ] mem 2 <DWL&m«. * h jm&tm 
% 1 (DWt&m^ * h *m^8tcc4si> a ciMfcfc l < 

*M*3I 1 7 EnottmiEIKim^ n AEtttt 
[0 0 0 1 ] 

«»Stifc«H* (CG (3>tV-^^77 * 9*X) 
[0 0 0 2] 

h^Ccfc^^^->y. > • X-f -7*>2\ 

XxAl£<2#Irfcfct,>T. 3>f*-^±{C«^$n/c 

(a) »ccj:s»a*«ofc*& 

: =fiW^*«£-r*. JfeHIWr^. 5 7 8. 7 57^ 
M(Stark), *a4$BP^4. 9 2 2, 430^ 
&fft (Wav i sh) . *S£ft»5. 0 5 6. 23 1 
^* (Nakano et a 1 . ) . #H¥6 - 8 
34 2 2-3&3L »B?2-2 24004^fi«. &m 
?6 -2 595 06#M »BJ¥7-1 0 0733^ 

[0 004] (b) SHI*«l*>t^'f'-/X<0*^CC^4B 

■10 ftttfefflBv 9 ^fcffSW ffl^J©*f*»*# 

#HWlFSI5. 1 5 0, 4 52-*&« <Po 1 1 
ac k) . ^HnmfllS. 3 4 7. 4 5 9^&$R (Gr 
eenspan etal. ) (C^£ftfc3&£*sc ft 

cc«s-rs. »k, *a«F«F»5. 347. 459^ 

mc\X. tMt*mHCfrtt9fcaMc. JfcB (a) ®i*t* 
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[0005] < c) T*urc^««i*nja»fl>«i« 

7^al/-^s> • (Conf igurat 

ion Space)" ±KHfiKG. ^F^HStCOa 
HWrffft5*5t 3RHWIW5, 0 4 7, 9 1 6^ 

s(Kondo) KH^snfc»sc*«cnccffla-r*. 

10 [0006] (d) r E. G. Gilbert. 

D. W. Johnson, andS. S. Kee 
rthi, IEEE Journal of Rob 
otics and Automation, Vo 
1. 4, No. 2. pp. 1 93-203. 1 98 

[000 7] C O&mz* 2 OO^l^OSM^ £ 
[0 00 8] 

[»H#l»UJ:^tt*lli] -his (a) - (c) (O 

J:i»*t!JdE (d) <D#ffi6ctb^afflttH«Ec**i % * 
<D — ^TC* ±iS ( a ) ~ ( c ) <D¥>mz. ±16 ( d ) <D 

[0 0 0 9] ±IS (a) 0E*»saKJ:£#;f£ 

[0 0 10] $6cc. ±sa (c) O^ttrtt, ^ 
±82 (b) tTOC aM3Wft<»^K:tt^9^*f*fiS 

LiW-fW^tO. «MBO»«:»t/T ut^^^acc^- 

50 £&r^C<b^ri?&C^ Jb&®*n»tK5. 047. 
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9 1 6#&«c»RStifcJ:Vj:. 3>^faU-^> 
[ 0 0 1 1 ] c ti% ( a ) - ( c ) ©^SficJt-^ ±fB 

(d) ©^aa*, m^mm^^jmt^rm^n^ 

AftrifiiHuraa^tftt^eis*^**. c© 

< -rzittoictoitzmi? z>&m»>* » *©&*»*> t 

[0012] *«BB:. ilWWCca*, 
flMKH*«SfcGLhS-fr % L^fc2o©a«fW©KIB 20 

[00133 

3 >X7cC*!*tOftjfi« *raE«* . ft 2 0(D« 
( 1 - 1 ) ±R2-r>OOto»<DMa8m&£ 5 0«r«S^* 

#ft£Mi*r & -Sti^cDUcgCDtiiB^ * h Jk *> b < 

< ««»jSK:ot»-C©rta^. *©-#©i5«(*©«2 
fc**fctt*»^«fil»'<* h 1 ©&#« 
( 1 - 2 ) ±Kfll 1 ©&£&"<* h*8W*8r#«>fc 

n/c^ifig^^ hiHr. iaftffi«it*©»ifi«jar*a>ia 
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kike* 4*2 ©aa*** b)m»ma:*ffiz.tcc t 
cooi4] *mxom 1 <mtmmmn$m.\z. 

< l - l ) ©» l ©*!£«'<* h;i/?H»#a{c*j^T, 
( 1 - 1 ) KB&OfcflOL WtfcflKJbfc ( d ) (DX 

*©r*s#. *ft«c£**&r <i-2> ©W2©« 
fig^* h;i/SW*acctot»r» ( l - 2 ) KffiilSLfc 

-jnucs-^t^r. ( i - 1 ) <om\<ow6&m^<t? b)im 

( i - 1 ) . ( i - 2 ) tciznbtt&mmicm 
rs<mmt % mmisit < 1 ) - o> ®tt*sBK«cit^ 

§*>>©#rfr< 2oodWfmottfiSt^»|fc3jtab 

ft 6 *»©C*!#© 5 *> £© 2 o©Oft##^ «* 0* 5 
T ftfc *> <!: © 2 ^©i&»flffl©*ffi«^ * h ;u 

*»©$ %jffl»c3ta«©»*s e«c i o<D«ra 

5 £ C> 5 <£ 5 (C L r 2 jffl© HI m W > 5f U - * «a L . 
jt$y*)-m±tcma&cmm (Depth-first 

OBftO^T^ja^U-r^SE (^1SS^7 - 1 7 4 6 2 7 

[0016] cct. ±aa*«wo* 1 o«»mraii» 
< i - 3 ) ±ta^2 <D^5Jt^^ h^aw*srat«>6 

[0017] ^»ccT»OTi>*^s^<o«e*s** 

» 1 <04fe{MDBIHRini»». JdB < 1 - 1 ) . < 1 - 
2) (DfrPSKJra*. 

( 1 - 4 ) ±IB2 ocDfiWi^O^ %<D— »3&sfl*liffr 
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( i - 6 ) iMB&mmwtt^fttfmtcm^rzoa 

[0018] *^<o«j»ra^«a»»a«, «e*ttt 
mmm&m*. ±me<d (i -4) - <i-5><d»?w 

t,>TC>*„ COtB^CC, ±§B ( 1 - 1 ) <D3Sl<D^fijg 
hiMIW^RTt*, ftffi¥-7 - 1 3 4 7 3 5#&$8 10 

OfiUH* H Littiir©a»«r<Z)#MK:* 6 i * OKSS^i 
*hji/S#^a«cto<,»r. »»3Cc^US5&aoi£li«(*«: 

mm?* t * b^s^^s^r©^ »»!Cc c ^ 

±ia ( i - 2) <o9zoms»^ v^mn^wtifi. ± 
ti£M»w&ib & b < «a» $ ti/d^c , uam i co 

&jfi&^ * h ;b«Mt#sec*ji »r b < ttSBBSt© 
«fi«^^ hji/*3R»4ci«:«*)0, Jtianr2<D^£ 

[0020] jsmistcimb b < «a«u^s»ccteii 

Bfr c > b a Htro^^ic * £ <h # ccm 2 (DM&m^ >? 

jitLxm^tcmmomj&m^^ b>\>&itjEt&ctic 

<k K) % ^@©»ttat b < B^»fc©e»fl^o^r © 40 

m&m^? b^^mfc^nmom.'rm^tbt^ —mo 
[0021]$ etc, ±Mtt&w<Dm 1 Gwtmvmm 

( 1 - 7 ) ±13 ( 1 - 4 ) (D»tt««iStt*«6CiBtt$ 
ftfc^ffi** «fctf±iB ( 1 - 5 ) ©J&K«f*K»r¥a 



^¥ 1 0 -74 2 1 5 
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[0 0 2 2] c©<fc5fc«S^S*«*.Sc£CcJ:*). 
OMfluoVttttBftC' b^?Btt«*ai®WK:}effl^S c 

t&x%z> a ±tzm&zmf&?tt&*mmmamfem 
nmmo 5 %<Dm2<o®i*mmm*&ai&* -#7ca 

02 ^^ia^i«a»«a<7)i«fiEic*f-r-s^fflttcn* 
Ttmoitm 1 o«ri*m«i^»<Dffffl & w-r * 

[0023] *9fflom2<D&#wm&m&iai\z. - 
##o*a»raa c tiffi^t b < ttswa* 

a««©/< » mm&ft ^mmmxm^L 2 tix 

f^^2o<D2;X7cMi*CD^iaS^^g|^, ^(D2o 
(2 - 1 ) i&2^<D£MW<Dm8&*£ 5 b*«-&* 

flh*©o*f*tem"*«fia««cific»ii*fe b < mm 

mz&^&m&^z bto*&bz&i<Dms.fr<* b& 
( 2 - 2 > hwsm 1 o^fi^^ ^ h *«> 6 

[ 0 0 2 4 ] C Ct t ±fE^^0^20«9#ffl£Miai 

(2 - 3 > ±ia»2<oKfis^^ h^aw^ar3R«>6 
[0025] ztc, ±^maom2<m»mamn 

mW&s 1E<2-1). ( 2 - 2 ) ©S^fMcft!*.. 
( 2 - 4 ) 2 ^<Ddh^5»<D ^) % <D-j5&&0>n&X$> Z 

( 2 - 5 ) OW(*o*«ft^t»bSC»*tB^"r 
^x. ^O^m^(01Mj^fj:^Lm&M<0»nrj:^V^ 

c 2 - 6 > a&m®#<mimnt£m^\ ( >x*<D{h&m 
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11 

[0 0 2 6 ] COii^C. ±13 (2-2) <DJH2<D&jfi 

t> D % SB 2 O&jfiJg^ * h ^»»*«te:tot»T^B©# 
«l*> U< «SBBI»«:*tf>6n^:>ffc«c«ifi«^^ h^«r 
$ £ icmtc teKBS« * h JMcflUW *> *> S c t 

[0 02 7] 3 Jja*ffe9!©SI 2 (OMtmmm 10 

( 2 - 7 ) JJBJBtttt «tt*RfcS5ttSnWBttfl« 

[0 02 8] * AUiiaBW*aflE^&*«W<0!»fl«!» 

KffiftAnaiC. K2o©o»fl«o. &S{4ilfjf$B£ 

(3 - 1 ) ±!B2oc0i^{*<D^^<b^ 
iSR^^ hn/CAoT, •€-(D2o<Da^Ji*<D'5^<D— ^ 

jit. #<DO^£^r*, *<D--%<D£M& 

( 3 - 2 ) ±ib^( 1 (D^as^ * h 

icmjET&m2<DMaB^*b*w*¥m*mr&w 40 
a. 

[0 0 2 9 ] *«!4>* 1 ©»*HK(i»»^0 

mtxo* 1 otttmRmjBtt&naL < 3 - 
1 )<JM 1 ©fcifi*'** h ^Sl»^cc*j^r . ( 3 - 

1) CCSBjeOfcKQi, m^a!L/c (d) OS:ffltCCiB 

-entcii'^e-r (3-2) o^2co®^«^ so 
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* h;MSJMMBlcfci>T, (3-2) «tiE»LfcJHfflK: 

3-3t>r . ( 3 - 1 ) 1 ©*jHb^* h^«j»*a 

iS9^^F^**«)-54©t*S^, 

fc k (3-1). (3-2) fcCiBttUfcSMSicS^< 
ttSUfc ( 1 ) - ( 3 ) 0SE5»ftffiCcit^Kae> 

[ 0 0 3 0 ] ft, 3 oO±©*»Ofii«f*^ffaL. * 

%is«ufc»»<o»*s e.cc i 

y ? U -H±«:|g«ife»* (Depth-first 

ia»«Ko^T«:acftnr*ffi (^m¥7 -174627 
[oo3i] c ct, ±ib*^0^<d^ 1 (DMimsmm 

( 3 - 3 ) ±iam 2 <D^i5S^ ^ h JbSW#Rr s» e> 

[0032] «JWK:T»or ^*3^^flM«eiS*«: 
s4W-rS»dfc*C^6"C*4. 5 etc. ±IS*»WO 

JftStifeftflOTIHKIIir^oy^Aj&s. ±IB (3- 
1 ) . ( 3 - 2 ) ©#*««Cfll^. 3 6«C 
( 3 - 4 ) JJB 2 ocDif^^cr) ^ ^<0-#^0*®<*r 

( 3 - 5 ) iJBflltBf«»©»«^K»^^*©ia 
[0 03 3] *«W©!»«:Mffi«aSgC^D Affit£& 
SBSftf51?7*C2 i/7A«, ±lfi<D ( 3 - 4 ) - ( 3 - 5 ) 
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mmcm>xi>*> 0 

[ o o 3 4 ] coii^c, ±ia ( 3 - i ) com 1 <D&3£ 

h^a*#Sr«. »H¥7 - 1 3 4 7 3 
* <fc 5 K , mi ©«ifi«^ * h ;l/SKc^ar©*2»^ 

±12 c 3 - 2 > ©^2 (om^m^^ bjmn^mt* ± 

SBfl^^»t>0<l33C»5nw»^«:, _LIBfHl© 20 

[0036] mmutcmbk l < i*mntvit&&ic*sii* 
x& m i <oms&^ ? V ^SSi»#ar«Bo« 

s& c> ufiwoas&ittwc * s t # «:» 2 ©aaaa^ ^ 
h^aijic^sr*«>^tiytiff«r©«ifi»^^ b^zmm 

£ 9 , ^H©*£3tf&S> t < ttXm©i!2i»*ccoi»T© 
J:t). #»&i>LX«©fctffcm©«»^* h*-c 

[ 0 0 3 7 ] ±aea w*a5W**»K©«i»pa 40 
i *r ^>«9f*^^st«»^ a 7 A«s«n s nfc 

t>T©sftWtt«wr3. so 
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[0 03 8 ] *»WO*2flD**IBE««»^n^A 

eafffttx. -x&a&nBv $> * c urn* 

*> 0 < WSStttfiMllR©^ ? mm&ft h ft AA«9 
(4 - 1 ) ±IB2o©ia«»©«^S*i^ l&ft&ft 

h^r&or, ^©2^<d£i^#©55©--;& 
*©-^©Citt#*atetr4. ^©-*©t»* 
*<D~*<D^m*&mmftx&zw&<D*<D{hfou 

(4 - 2 ) ±iemi (om&m^z YMtm.^WLx$c&>h 
mmm*?* ^ a^ums nr» ^ci t *r 

[0039]ccr, ±ia*»q«©» 2 ©»WQ8gtt« 
( 4 - 3 ) ±MZW 2 ©^j5^-< i> h *9»¥BV##> 6 

[0 040]^, ±IS*«?B©*2 O^^PelEffil^C 
S^^5A^ Jbie (4- 1 ) . (4-2) 

(4 - 5 ) attffM<*©»t«imK:S^^r«©aAff 

[004 1 ] C©^CC, ±IB ( 4 - 2 ) <DHI2 ©^ 
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[0 04 2] 

■wits, ant *«w©«*ia^8Ks»sgg(o-n 

£o io 
[0 04 3] 0 1 K^T^fc'^-^X^A 1 oo 

cpu^mo otata^**) k^?«b*# 

rtjaSttfc^ftSPl 0 l. #f*Sl 0 DfefcofSWcJ: 
0 . a^HB 10 2a ±fcH«4«^-r 1 

0 2. C(03>b , a-^^7'A 1 0 05CfI*<DltfR£ 
A#t-£fcafr<D*~#--Kl 0 3. S«^a510 2(O 
1^11 1 0 2 a±©tt*©ffiH*!BS"rS-7$* 1 0 

4. *mi<mtmmffim#7n#*i*o-mm&mz 
[0 044] setts i o 5 cc««3nfe»#raffijBi?ii» 20 

X*) 1 1 0«C*MftSftT:te*K -£<DMO 1 1 0£C<D 

01 K^T3>t*-$^fA 1 0 OOCSSSLT. C 
> t: » — dr S/X ^ A 1 0 OCCT^n- F3ft&. 

Al 0 0«C«ttStlfc«#lfflffi«^n^A*. MO 1 
1 Ofc^Z/P- FU ^OMO 1 1 OSr/rbTffeCDn 

> b* * - 3? >x a tc^-r c 1 4> r # 60 
[0045] htcb. «j(*raiffi«B»»»a(oiiJ©ess 

©niteB«r*o. wo^7A*i. tmztiMm 
a#moi 1 ofc»ttsnn»a±*«. -eo^ta*^ 
[ 0 0 4 6 ] s 2 it. m^wfflsmm»>- 

tt2 0S«»©^-*<^ft. KttO^SIK* tt@£2 

^■r®f*Bira«iai»sssi o«ci», jftXMttEtt^ai 
i****6hTt>a. Jgttf**S2S*ai ice;*, 
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*Hffi8i»(a<D^m ± a a 2 mcmm> * %o>j>tz< 
t h i r?©ia»*»wa^K: j: o rass naoftB^ 

#iets o r fee > r . * <dib i« $ nfctHRA cc o »e $ 
ti«QM'<??is. ^««b^ 

6 2O0rM^^(D^^^^-^<7>i£^fl:«. aftB^ft 
t?*otU<, **wm*,©»£*6fc*i&*Btt 

[0047] fcmnmm&M 1 1 ccsattstrc 
si ifrhm&mztitcBffifmicm^x. 

[0048] JBtflffttiEtt^R 1 1 ^88*Hi$nfcfiI 
»Kffiil;-C<D^«a. *£eF^fMRKIr#»l 2 

1 3 CCA* 3 n*. C ©*B>< v ?flm£rt#S 1 3 X 

tW«r*-5. CCDii^. ttB^?^fm£tt^Rl 3 
KftttfUGIr^Sl 2rH*Stifc«<0iE!i«B* 

[0049] ftB^>- v nm^^m 1 3 u/ca 

1 3 £iggJ (/MBttW «© 5 ^MftW 
*D-rJB«t&fB«. » 1 <D^®g^ f h 1 5 <c 

g-c^ h^sifai btc£zmn.te^x$>z>iL&. 

[005 0111 <£>^£lg"<* h 1 5 r». 
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)wm> h ti s . c <Dm i * h i 

^>6gtn/cm^^ o < tem®&.ic^x<Dftm£ o & 
^^^cfii^^ic^ji^^ffl$n^ 0 common io 

coo5i] com i (ommz^v hM%%^& i st 

5r#&6ftfcSi5&^ HHi. >tf&£ft*2o©dIi 
2©«itt*^f h^!BI*ai 6*CA*3*i*. ^©JH 

£50 *»^*ifi«^ * h ;u £ tfiESef -5 <t I > 
[005 2] *2<7)S3^^^ h ;USW*» 1 6 

«^#ai 4 teste ft, ««*ai4r», *t^<tor 
;u»**Si 5tt'W'<xft<,>o*il0OT, jtacc. 

*2<D«i£g^^hJVa*^ai 6tCA#3ft*. S&2 
©KfiS^ * h Atfffl^S 1 6 r«, ff!2 7 U- AKB 

[0 05 4] «±©J:5ccot* 4KB, S* 

orc»*o2o©flw«^»»«:i»L,«*ort>s so 
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tm±> *n6 2o©o!ft(^T^«6c***iS*>*s 
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